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A novel Automatic Frequency Control (AFC) loop based on an Extended Kalman 
Filter (EKF) is introduced and analyzed in detail The new scheme involves an EKF 
which operates on a modified set of data in order to track the frequency of the incoming 
signal The algorithm can also be viewed as a modification to the well known cross- 
product AFC loop . A low carrier-to-noise ratio (CNR), high-dynamic environment is used 
to test the algorithm and the probability of loss-of-lock is assessed via computer simula- 
tions. The scheme is best suited for scenarios in which the frequency error variance can 
be compromised to achieve a very low operating CNR threshold. This technique can 
easily be incorporated in the Advanced Receiver (ARX), requiring minimum software 
modifications. 


I. Introduction 

The algorithm introduced and analyzed herein is another 
application of the theory of Kalman filters [1] to the prob- 
lem of estimating the parameters of a sinusoid embedded in 
noise. The use of Kalman filters in tracking time-varying 
parameters in general and the phase and/or the frequency of a 
sinusoidal signal in particular, has been well investigated by 
many researchers and is extensively documented in the litera- 
ture [2] -[4] . In this particular application, the parameter of 
primary interest is the frequency of a pure sine wave which 
should be estimated in the presence of high dynamics at a low 
carrier-to-noise ratio (CNR). Typically, it is applied in a region 
where the Phase Locked Loop (PLL) loses lock frequently due 
to cycle slipping [5] and hence is unreliable. 


The scheme sought should be easy to implement and 
possess the same order of complexity as the PLL. The goal 
here is to be able to track the frequency at a low CNR with 
a simple scheme that trades complexity for root-mean-squared 
(rms) frequency error performance. The automatic frequency 
control (AFC) algorithms discussed in the literature are 
typically more complex than the PLL [6] , [7] except for the 
cross-product AFC loop, which performs poorly in terms of 
lowest operating CNR. In a typical operating environment, if 
the PLL loses lock due to a severe maneuver by the trans- 
mitter, the proposed simple AFC algorithm could then be 
used to track the doppler until the dynamics are well within 
the tracking capability of the PLL, which can then track 
again with the frequency initialization provided by the AFC 
algorithm. 
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II. Description and Analysis of Algorithm 

One approach to tracking the frequency of a sinusoidal sig- 
nal at a lower CNR than the PLL lies in modeling the dynamic 
process in differential form and hence tracking only the differ- 
ential dynamics. Thus in this model, the phase process can not 
be tracked directly and is really compromised in order to fur- 
ther lower the threshold at which the frequency process can be 
estimated. However, given its initial value, the phase can later 
be derived from the frequency by integration, assuming the 
latter is estimated with a suitably small rms error. 

There are numerous ways to arrive at a differential signal 
model to track the frequency; for example, each of the in- 
phase and quadrature samples at a specific time can be ex- 
panded using a Taylor series as a linear combination of the two 
previous samples [8] and that, after some further processing, 
can lead to a signal model in the desired form. The disadvan- 
tage of this scheme is that it tends to be quite computationally 
demanding because it considers higher-order approximations 
to the measurement function. In this article, the phase infor- 
mation is removed by manipulating the samples in a more 
direct manner, i.e., a simple cross-product between the in-phase 
and quadrature samples is performed in a manner similar to the 
cross-product AFC loop. The modified samples are then fed 
into an Extended Kalman Filter (EKF) that tracks the differ- 
ential phase change from which the doppler can be deduced. 

In the derivation to follow, the vector notation which is 
standard in the theory of Kalman filters is adopted. The re- 
ceived signal is observed in the presence of additive narrow- 
band white gaussian noise with one-sided power spectral den- 
sity N Q (watts/Hz). The carrier is first removed by mixing the 
observed waveform with a fixed reference, after which the in- 
phase and quadrature signals are sampled at a fixed rate f s = 
77 1 where T s is the sampling time. Hence the samples that 
need to be processed can be expressed in vector form as 


r{k) = 


’>}(*)' 


A sin 6(k ) 

N k \ 


A cos 6(k) 


+ n(k) 


0 ) 


where ^ denotes the 2 X 2 identity matrix. Typically, the re- 
ceived samples rj(k ), r^(A:) form the input to an EKF with a 
state vector consisting of the phase d(k) and its various deriva- 
tives since the latter is modeled as a polynomial in time of 
sufficient degree to account for the dynamics encountered. 
The advantage of this approach is that it tracks the phase and 
frequency with small rms error when operating above thresh- 
old, defined here as the CNR at which frequency loss-of-lock 
occurs with a probability of 0.1. Because frequency is the pri- 
mary parameter in this application, we expect to further lower 
the operating threshold by compromising the phase estimates 
and the rms error performance. The block diagram of the new 
scheme, referred to as Frequency EKF (FEKF), is shown in 
Fig. 1. The cross-product is performed in order to remove the 
phase from the samples, as follows 


= r^r^k - 1 )~r Q {k)r I {k - 1) 

(3) 

2 Q (k) = rj(k) rj(k - l) + r Q (k) r Q (k - 


In doing so, the effective noise has been increased and this will 
of course result in a larger frequency error. The modified sam- 
ples Zj(k) and Zg(k) are then used in the EKF which tracks 
only the differential phase, not the pseudo-phase. This results 
in a reduction in the order of the EKF and hence in complex- 
ity. Defining CNR as the carrier power to the one-sided power 
spectral density level of the noise, we have 



(4) 


From Eq. (2), N Q is equal to 2T s o 2 where o 2 is the variance 
of the noise samples n f (k), n Q (k ). Hence, CNR can be ex- 
pressed in terms of o 2 as 


CNR = 


2 ry 


(5) 


where k is the discrete time, d(k) the phase of the received 
signal, A its amplitude and n T (k) - [nj(k) n Q (k)] is a zero 
mean gaussian vector, the subscripts / and Q denoting the in- 
phase and quadrature components respectively. Hence, 


Without loss in generality, we can now set A to unity, as the 
CNR and the sampled noise variance are inversely related by 
Eq. (5). Plugging Eq. (1) into Eq. (3) and expanding, we easily 
obtain 


E[n(k)] = 0 


E[n(k)n T (k)] 



( 2 ) 


Zj(k) = sin A 6{k) + n' J (k) 

( 6 ) 


z Q (k) = cos A d(k)+n'g(k) 
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where the effective noises rij(k ), n^k) are given by 

n^k) = n f (k - 1) sin 6 (k) + n Q (k) cos 6 ( k - 1) 

+ « 7 (k - 1 )n Q {k)-n Q (k - 1) cos d(k) 

- n f (k) sin d(k - 1) - « 7 (k) n Q (k - 1) 

rig(k) = rig(k - 1) sin 6(k) + n Q (k) sin 0 ( k - 1) 

+ n Q (k) n Q (k-\) + n Q (k-\) cos 6(k) 

+ n f (k) cos 6(k - 1) + n^k) n^k - 1) 

and the differential phase at time k is defined by 

A6(k) = e(k)-0(k- 1) (8) 

The differential phase itself can be modeled as an nth order 
polynomial whose derivatives constitute the components of 
the state vector x(k) of the FEKF as follows 


In the above, J(t ) stands for jerk and denotes the second 
derivative of the differential phase or the third derivative of 
the pseudo-phase. Assuming that the jerk is a zero-mean white 
process with one-sided spectral level Nj, we obtain 

E[vlm = =o)T] (13) 

(7) where oj denotes the variance of the sampled version of J(t). 
Denoting by Q the covariance matrix of v.(k), it is easily shown 
[3] that 
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The EKF equations are derived in [1] and are repeated below 
for convenience in recursive form. 

x(k + l/k) = x(k/k- 1) + K(k) [z(k)-h(x(k/k-l))] 


A6(k) = i r x(k) ; = [1,0, ... ,0] 

x(k + 1) = 


(9) 


where is a disturbance term that models the random 
changes in parameters due to dynamics, and $ denotes the 
state transition matrix. In the remainder of the paper, we will 
concentrate on the second-order FEKF, but the analysis can be 
generalized to any order. For a second-order FEKF, the state 
x T (k) becomes 


x T (k ) = [A0(fc) Aco(A:)] (10) 


where Aco(k) is the derivative of Ad(k). In that case, Eq. (9) 
yields 

A0(k + 1) - A0(k)+T AO^ + v^k) 

(ID 

Aco(k+l) = Ac o(k) + v 2 (k) 


where 


r kT s t 2 — / 

>»/(*) = -n~lv J ^ dT ; /=1 > 2 

J(k-l)T s K h 

( 12 ) 


(15a) 

K(k) = $ £(*/* - 1 )H{k) [^(k)^(klk - \)H{k) + 

(15b) 


Y (* + */*) = a2 £ !>/* - - 2 >/* - l M k ) 


• (H T (k)Y( k / k - op ) + *) _1 

•H T (k) 2 (*/*- l)j£ r + G (15c) 

where 


*(£(*)) = 


sin (£5 *W) 
cos (£ r x(ft)) 


H T (k) = ~h(x) | x= 


\x=7(k/k- 1) 


cosA0(k/k-l) 0 
- sin AO {k/k - 1) 0 


(16) 
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and R is the covariance matrix of the noise vector g(k) given 
by 


where H(z ) denotes the closed loop transfer function, related 
to the loop filter F(z) via 


R = o*l ; o* = 2 (a 2 +ct 4 ) (17) 


The weighting coefficient a is typically used to adjust the clas- 
sical trade-off between adaptation time in transient situations 
and steady-state error. The noise sequences n'j(k), n^k) are 
colored but Eq. (17) reflects the statistics only at a specific 
time. No attempt is taken to whiten the sequences in order to 
abide with the original goal of a simple scheme. The weighting 
coefficient a can be used in addition to o j to control the 
effective bandwidth of the EKF, as will be shown later in the 
linear analysis. 


The performance of the FEKF operating in the presence 
of noise can only be derived in the steady -state, in which case 
the matrix 2(k + \jk) is independent of k. From Eq. (15c), 
it is not clear that the FEKF will reach steady state because 
l,(k + 1 jk) depends on the matrix#(/r) which in turn depends 
on the predicted value A d(k/k - 1). However, it is shown in 
the Appendix that the right-hand side of Eq. (15c) is in fact 
independent of &§{k/k ~ 1), and that both the linear and non- 
linear filters reach the identical steady state. Furthermore, an 
equivalent steady-state nonlinear model is derived in the 
Appendix which is used to compute the error variance in white 
noise. Defining the steady-state matrix Z to be 


y> lim y](/c + 1 Ik) = 

^ k-+°° ^ 



(18) 


the equivalent linear loop model is shown in Fig. 2 where 
n eq (k) denotes the equivalent noise given by 

n eq (k) = n’jik) cos (k) - n^k) sin A$(k) 


(19a) 


with power spectrum (assuming <p(k ) = 0) 


H{z) 4 


F(z) 

l+F(z) 


z{o]+Tp)- of 


z2 (°i + tf) + z ( T s P- a 


■2(7*) + °n 


( 21 ) 


The closed loop transfer function is depicted in Fig. 3 for a 
fixed a (1 .005), Nj (200), and 7^(2 msec). The corresponding 
loop bandwidth B L defined in the Appendix is shown in Fig. 4 
versus the ratio a?/a 2 . When the measurement noise is domi- 
nant (i.e., oj/o„ « 1), the bandwidth is independent of CNR 
and is controlled by a. On the other hand, when the loop is 
dominated by the process noise (i.e., oj/o 2 » 1), the band- 
width is a function of both CNR and a. The performance in 
the absence of dynamics is shown in Fig. 5 as a function of 
CNR when T s = 2 msec. The theory and simulation are in agree- 
ment as long as the loop signal-to -noise ratio (SNR) is “high.” 
For low loop SNR, the loop is nonlinear and the performance 
is degraded. Note from Fig. 6 that the noise power spectrum is 
not always white in the loop bandwidth, hence Eq. (20) can 
not be simplified any further in general. 


III. Performance in a Dynamic Environment 

The performance of the FEKF in a dynamic environment 
can only be assessed through simulations. In order to compare 
the performance with other schemes, the FEKF was tested in 
the presence of the identical dynamics described in [9] , which 
exhibit two 100 g/sec jerks lasting for 0.5 sec each. For a 
fixed sampling time of 2 msec, the best performance in terms 
of lowest achievable CNR threshold is obtained when a is 
1.005 and Nj is equal to 300. This corresponds to 22.5 dB-Hz 
(Fig. 7) with an rms frequency error 41 .2 Hz (Fig. 8). The loop 
bandwidth at threshold is about 7.1 Hz with a 35.2 Hz steady- 
state error due to the jerk. The contribution of the noise in the 
linear model is about 27.3 Hz. Note that for fixed a and Nj , 
the loop bandwidth is a function of CNR as mentioned earlier. 


S n (z) = -o 2 z + 2(a 2 + a 4 ) - a 2 z 1 (19b) 

Letting <p(k) = A 6(k) - A 6(k) denote the differential error 
phase at time k y it is shown in the Appendix that the error 
variance is given by 



Compared with other frequency tracking schemes using the 
same trajectory, the threshold of the FEKF is 3.5 dB lower 
than the PLL, 2.2 dB better than the CPAFC loop, 1.5 dB 
better than a fourth-order EKF tracking phase, and finally 
0.5 dB more efficient than the approximate Maximum Likeli- 
hood (ML) scheme described in [9] . However in terms of rms 
frequency error, the FEKF is worse than all the above loops 
except for the CPAFC loop which exhibits an inferior perfor- 
mance. In terms of complexity, the FEKF requires the same 
number of computations per update as the PLL when imple- 
mented in the steady state. 
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IV. Conclusion 

A new AFC loop was introduced and analyzed. The heart 
of the loop involves an EKF which operates on a modified 
set of data in order to track the frequency. The scheme can 
also be viewed as a modification of the well known cross- 
product AFC loop. 

A detailed analysis of the second-order loop was presented 
and verified via simulations. The parameters of the FEKF were 


related to tracking parameters such as loop bandwidth and fre- 
quency jitter due to noise. The steady-state error due to jerk 
was also assessed. 

The algorithm is best suited for scenarios in which fre- 
quency error is of secondary value and lowest operating CNR 
threshold is of primary concern. This technique is easily imple- 
mented and requires a minimum amount of computations per 
update. Moreover, it is highly suited for the ARX as it requires 
minimum software changes. 
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Fig. 1. General block diagram of the FEKF. 
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Appendix 

Performance of the FEKF in the Steady State 


The error covariance matrix 2(fc + l/k) satisfies the recur- 
sive Eq. (15c) which seems to depend on A@(k/k - 1). Defin- 
ing the matrix 


Q(k) = H T (k)Z(k/k - \)H{k)+R 


(A-l) 


and replacing ]±(k/k - 1) by its steady-state value given by 
Eq. (18), we have (letting x denote A d{kfk - 1)) 




cosx 0 
-sin* 0 


<7? P 



> 

0 

+ 

n 


0 

1 

V 


o? cos 2 x + a 2 -a 2 cos x sin x 

1 n 1 


-a? cos* sinx a? sin 2 x + a 2 

l in 


Inverting £2(fc), we obtain 
1 


Q (k) 


o 2 a 2 + a 4 

n 1 n 


(A-2) 


a 2 sin 2 x + a 2 a? sinx cosx 

1 n 1 


a 2 cos x sin x a 2 cos 2 x + a 2 


(A-3) 


which when pre- and post-multiplied by H(k) gives 


would have resulted in the same matrix as in Eq. (A4) and 
hence in the identical matrix 2. 

In the steady state, the measurement vector z(k ) is sub- 
tracted from the prediction h( •) before being multiplied by 
the gain matri *K(k) as in Eq. (15a). Defining ^(k) to be 


L(k) = OPg' 1 ^) 


A .ft , 


we obtain in the steady state (x = A6(k/k - 1)) 


(A-5) 


L(k) 


a 2 p 


cosx -sinx 
0 0 


a~ l (k) 


i 


o 2 + o 2 
n n 


a 2 cosx -a 2 sinx 


L(k)[z(k)-h(x(k/k-l))] = L{k) 


(A-6) 


pcosx -psinx 
which when multiplied by z(k) -fc(*) yields 

Zjik) - sin Ad(k/k - 1) 


Zg(k) - cos A d(k/k - 1) 


H(k) |2“ 1 (k) H T (k) 


cosx -sinx 
0 0 


= [Zj(k) cos A §(k/k - 1) 

- Zg(k) sin A @(k/k - 1)] 


• |2 _1 W 


cosx 

-sinx 


o’ 

0 




(A-7) 




1 0 
0 0 


(A-4) 


Equation (A-7) combined with Eq. (15a) suggests the structure 
depicted in Fig. A-l. The output of the frequency disciminator 
d ( k ) is given by 


which is independent of A 6(k/k - 1). The steady-state matrix 
2 can be computed in closed form only when a is equal to one 
[10], otherwise the solution can only be obtained numeri- 
cally. One approach is to run the FEKF until it reaches steady 
state and the resulting matrix is a solution of Eq. (15c) because 
of the properties of Kalman filters. Note also that the linear 
measurement (i.e., z(k) = A 9(k) + n’(k)) with H T = [1 0] 


d{k) = z^k) sin A0 (k/k - 1) - z^(k) cos A d(k/k - 1) 

(A-8) 


Using Eq. (6), d (j k ) simplifies to 

d{k) = sin <t>(k) + n eq (k) (A-9) 
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where q(k) denotes the differential phase error and 

n eq (k) ~ n j(k) cos A6(k/k - 1) - n q (k) sin M(k/k - 1) 

(A- 10) 


It is straightforward to show that 


where H(z ) is the closed loop transfer function given by 


H{z) = 


F{z) 

1 +F(z) 


z(<Z+T s p)-o \ 

z2 (°l + °n > + Z ( T s P - °l ~ 2a «> + °n 


(A-16) 


E[n 2 eq {k)] = 2 (o 2 + a 4 ) 


(A-l 1) 


E[n eq (k)n eq {k±\)] = -a 2 cos [<t>(k) - <p(k - 1)] 


From classical digital phase locked loop analysis, it is straight- 
forward to show that the error in the absence of dynamics is 
given by 


which, assuming zero error, results in the following power 
spectrum 


S neq {z) ~ -o 2 z +2(o 2 + o 4 ) ~ o 2 z 1 (A-12) 


CYt 

\ l = T I ' \h ( e i2 ” fT °)\ 2 S„ eq (e /2nfT j df (A-l 7) 


while the steady-state error due to jerk (in units of m/sec 3 ) is 


The resulting nonlinear model is shown in Fig. A-2. Using z- 
transforms, it is straightforward to show that 


•Pjrad) 


■(?) 


J T l 
J 0 I s 


( o 2 + a 2 ) 

K 1 n ' 


(A-l 8) 


2(z) = 


1 

(z-1) 2 


z - 1 


0 


T s 


z - 


W(z) 


(A-13) 


where co f * is the radian frequency of the incoming signal and c 
the velocity of light (in m/sec). The one-sided closed loop 
bandwidth B L {Hz) defined by 


where Z(z) and W(z) are the ,z -transforms of x(k/k - 1) and 
co(k), respectively. The loop filter F(z) is then easily derived 
and is equal to 


F(z) = [1 0] 


1 

z - 1 

T 1 


’l T 



s 

(z-1) 2 

0 

L 

z-1 


0 1 



(o 2 + a 2 )(z - l) 2 


(A- 14) 


Figure A-3 depicts the simplified nonlinear model in terms of 
the loop filter F(z). Approximating sin (<; p(k )) by 0(fc ) for 
small error, we have, using operator notation 


0(z) = [1 -tf(z)] A d(z) -H(z) {n eq (k)} (A-15) 


B l (Hz) =^T— —^T§ H ^ H ( z ~ 1 )^ ( A - 19 ) 

2T S H 2 ( 1) 2lrl J 2 

can be computed in closed form using the results found in 
[11] to give 


1 


B,{Hz )= w 




2T S (a 2 - a 2 )(a Q + a 2 ) - (a Q - a 2 )a{ 


where 


b z = -°i’ b i = °\ + T s p 


a 7 = °n’ a l = T sP-°\~ l0 l 


(A-20) 


and 


a - o 2 + o 2 
o 1 n 


B o= b t + b l’ *r = 2b i b 2 


e i = % +a 2 


(A-21) 
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